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(54) Apparatus and method for calculating azimuth angle 



(57) An apparatus and method of compensating for 
the change of an earth magnetic sensor output accord- 
ing to an attitude (roll and pitch) using an- inclinometer 
in the case of calculating azimuth information using a 
two-axis earth magnetic sensor is disclosed. The atti- 
tude of the earth magnetic sensor module is measured 
using the inclinometer, and a coordinate conversion ma- 
trix for converting a body coordinate system to a hori- 
zontal coordinate system is calculated. Z-axIs direction 



virtual earth magnetic data at the present attitude of the 
earth magnetic sensor module Is generated using the 
output of Ihe two-axis earth magneb'c sensor and the 
calculated attitude information. After the generated Z- 
axis earth magnetic data and the measured X-axis and 
Y-axis earth magnetic data are converted into the hori- 
zontal coordinate system, the calculated azimuth angle 
is considered as the azimuth angle of the earth magnetic 
sensor module. 
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Description 

[0001] The presant Invention relates lo a measurement apparatus and calculation method whrpii can calculate ac- 
curate azimuth information. ' 
5 [0002] Up to now. there have been efforts to provide a method and apparatus for calculating azimuth information of 
a vehicle or a sensor module which moves in free space* using an earth magnetic sensor such as a fluxgate. However, 
since the fluxgate is expensive and large-sized, it has been used only for navigation. 

[0003] Recently, small-sized and low cost earth magnetic sensor modules have been developed, and especially, 
with the development of MEMS technology, chip type earth magnetic sensor modules have been developed and used 
in diverse fields which require azimuth information. However. In the application fields where the earth magnetic sensor * 
module cannot be leveled, accurate azimuth information cannot be obtained only through the earth magnetic sensor 
[0004] Generally, the earth magnetic sensor Is a device for measuring the strength of the earth magnetic field, and 
it can measure the strength of the magnetic fiefd accurately only in the case that a flux vector of the earth magnetic 
field Is parallel to a vector of a measurement axis of the sensor for measuring the flux vector. In this case, when a two- 
1^ axis earth magnetic sensor In which each axis is orolhogonally arranged with a right-hand rule, is horizontally mounted 
to form a sensor module, the azimuth angle Indicated by the sensor module is calculated using outputs, of the two ' 
sensors. 

[0005] However, if the earth magnetic sensor module cannot be leveled, the strength of the earth magnetic field 
cannot accurately be measured, and the azimuth information at this time may include a great error. Consequently, the 
20 error according to an attitude should be compensated for, and for this, an error compensation through a. coordinate 
conversion is performed using a three-axis earth "magnetic sensor and an inclinometer for measuring the attitude. 
[0006] With the development of a small-sized earth magnetic sensor, the attitude error compensation technique 
expands Its application fields to sports, multimedia, game machine, etc. 
. 10007] However, in the case of using the two-axis earth magnetic sensor due to the problems of a sensor installation 
25 space, the error cannot be compensated for only through the developed error compensation technique, and thus the 
azimuth angle calculated Increases in error according to the size of the attitud'e. 

. [0008] • According to a first aspect of the InvenUon. there is provided an apparatus for calculating an azimuth angle, 
comprising a two-axis earth magnetic sensor, mounted on a device which requires azimuth Information, for measuring 
a strength of an earth magnetic field, a two-axJs irrclinometer for providing attitude information (such as roll and:pitch 
^ angle), a signal conditioning unit for filtering a signal measured by the sensor and converting the filtered signal Into a 
digital value, a microprocessor for calculating the azimuth angle "using the strength of the earth magnetic field measured 
by the earth magnetic sensor and an output of the inclinometer, an LCD module for displaying the calculated azimuth 
information, and a serial communication Interface for transmitting the sensed signal processed by the microprocessor 
and the calculated azimuth InformaUon. 
35 [0009] According to a second aspect of the Invention, there is provided an apparatus for calculating an azimuth angle, 
comprising a two-axis earth magnetic sensor; a two-axis inclinometer and means for calculating an attitude using an 
output of the inclinometer, and for calculating azimuth by compensating for an attitude ern^r of the two-axis earth 
rriagnetic sensor, 

[0010] The invention can thus compensate for an attitude error of an earth magnetic sensor using Information on an 
40 earth magnetic field obtained from a two-axis earth magnetic sensor and an inclinometer. Accurate azimuth information 
can then be obtained. 

[0011] The Invention also preaviqles a method of calculating an azimuth angle, comprising the steps of setting a data 
output period using an Internal timer mounted on a microcomputer, converting an analog value sensed by a sensor • 
into a digital value, storing the converted sensor data in an internal register of the microprocessor, calculating a coor- 
dinate conversion matrix using Inclinometer data, generating a virtual 2-axis earth magnetic data, calculating earth 
magnetic data on a horizontal coordinate system using a three-axis earth magnetic data (i.e., the two-axis earthy 
magnetic sensor data plus the one-axis virtual sensor data) and the coordinate conversion matrix, calculating the 
azimuth angle using the calculated data, and if a timer interrupt Is generated due to the output period set in the Internal 
timer, transmitting the sensor data and the calculated azimuth data to an external system through a serial communi- 
sm cation and displaying the sensor data and the calculated azimuth data on an LCD module. 

[0012] The apparatus and method of the invention enables accurate azimuth information to be calculated by com- 
pensating for an attitude error of a two-axis earth magnetic sensor. In the case that the two-axis earth magnetic sensor 
is mounted on a device which requires the azimuth information (for example, a navigation system, game machine, 
PDA, cellular phone, etc.), the apparatus and method according to the present invention can calculate the attitude 
S5 Information using a two-axis Inclinometer, and then compensates for the error according lo the attitude of the earth 
magnetic sensor to obtain the accurate azimuth information. 

[0013] An algorithm for obtaining the coordinate conversion matrix for converting the earth magnetic sensor data 
into the horizontal coordinate system may comprise converting a unit of the inclinometer data stored in the internal 
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register of the microprocessor into an SI unit by multiplying the inclinometer data by a scale factor, calculating an 
altitude using the converted inclinometer data, and calculating the coordinate conversion matrix using the calculated 
attitude value. 

[0014] An algorithm for generating the virtual Z-axis earth magnetic data In the case of using the two-axis earth 
5 magnetic sensor may comprise selling earth magnetic data measured when the earth magnetic sensor points to a 
vertically downward direction of the earth, and generating the virtual Z-axis earth magnetic data using the calculated 
attiiuda information and the X-axIs and Y-axis earth magnetic data. 

[001 5] Preferred erhbodiments of the invention will now be described in detail with reference to the attached drawings 
in which: 

10 . . 

FIG. 1 .is a view illustrating a method of calculating an azimuth angle by compensating for an attitude error by a 
two-axis earth magnetic sensor according to the present invention: 

FIG. 2 Is a view illustrating the construction of a two-axis earth magnetic sensor and an attitude error compensation 
apparatus according to the present invention; ' 
IS FIG. 3 IS a flowchart illustrating the operation of the microprocessor mounted on the two-axis earth magnetic sensor 

and an attitude error compensation apparatus according to the present invention; 

FIG. 4 is a graph illustrating the experimental result of the attitude calculated using the inclinometer according to 
the present invention; • 

FIG 5 is a graph illustrating the .experimentiai result of the virtual Z-axis earth jnagnetic data calculated using the 
20 two-axis earth magnetic sensor and the inclinometer; and 

FIG. 6 is a graph illustrating the experimental result of the azimuth angle calculated using the tWo-aids earth mag- 
netic sensor and the inclinometer. 

[0016] An apparatus and method of calculating an azimuth angle according to preferred embodiments of the present 

25 Invention will now be described In detail with reference to the annexed drawings in which like Keferance numerals refer 
to like elements. . ' ■ 

' [0017] FIG. 1 is a view illustrating a method of calculating an azimuth angle by compensating for an attitude error 
by a two-axis earth magnetic sensor according to the preserit invention. The method includes a two-axis earth magnetic 
sensor 101,. an inclinometer 102, an attitude (e.g., coordinate) conversion matrix 103, a virtual Z-axis earth magnetic 

30 data generation 104, a earth magnetic data coordinate conversion 105, and an azimuth angle calculation 106. 

[0018] The earth magnetic sensor 101, which may be a fluxgate sensor or a magnetoreslstlve (MR), measures the 
strength of the earth magnetic field, and comprises a two-axis earth magnetic sensor having an X-axis in the forward 
direction of the sensor module and Y-axis in the rightward direction from the X-axis at an angle of 90°. 
[0019] The inclinometer 102 measures a tilt angle of the sensor 101 with respect to the earth surface, and an accel- 

35 erometer may be used as the inclinometer. In the case that the acceierometer, which measures only the acceleration 
of gravity at a standstill, is used as the inclinometer, the attitude information can be calculated by measuring the ac- 
celerations of dffFerent levels according to the attitude using the two-axis or three-axis module arranged at right angles. 
In the case of using the two-axis accelerometer. the acceleration is measured through Equations la and lb and the 
. . attitude is calculated using Equations 2a and 2fa. 

40 ' . . • 

aj^ = gr'sin 0 ' (la) 

4S ay-g sln^ (lb) 

0=sin^ay/g) (2a) 



50 



55 



. 8 = sin''' (a^ / g) {2b) 

[0020J Here. 3^ and ay are output values of the X-axis and Y-axis accelerometer. g is the acceleration of gravity, and 
<|> and 9 are a roll and a pitch angle, respectively. 

[0021] The coordinate conversion matrix 103 is for converting the earth magnetic sensor data into the horizontal 
coordinate system, and Is constructed as follows using the attitude information calculated using the output value of the 
inclinometer 102. 
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C* = 



cosd sin ^ sin ^ sin ^ cos 
0 cos^* -sin^ 
-sin^ cos^sinii cos^cos^* 



(3) 



10 



[0022] The virtuaf Z-axis earth magnetic data 1 04 is for the attitude error compensation of the two-axis earth magnetic 
sensor, and is calculated as follows using the two ou,tputs of the earth magnetic sensor and the attitude Information as 
calculated above. 



t5. 



_Zf^ + sin9-Vy^ sin(^cos9 
J9 ' COS(|>COSO 



(4) 



20 



[0023] Here, is the strength of the earth magnetic field first measured by experiment when a measurement axis 
of the earth magnetic sensor points to a vertically downward direction of the earth, 

[0024] The coordinate conversion 1 05 of the earth magnetic sensor data to the horizontal coordinate system is per^ 
formed as follows. 



25 



(5) 



30 



35 



[0025] Here, [Xjg Yjg Zjg ]^ Is the earth magnetic sensor data. 

[6026] The azimuth calculation 106 is performed as follows using the earth magnetic data the coordinate of which 
is converted Into the horizontal coordinate system. 



* = tan-^ {Y^/X^) 



(6) 



[0027] FIG. 2 is a view illustrating the construction of an interface for a two-axis earth magnetic sensor constructed 
to perforrn the function of FIG. 1. The Interface includes a two-axis earth magnetic sensor 201, an inclinometer 202. 
a signal conditioning unit 203, a microprocessor 204, an LCD module 205. and a serial communication interface 206. 
[0028] The signal conditioning unit 203 comprises a low-pass filter for removing a power supply noise and a high- 
frequency noise, and an analog-to-digital (A/D) converter for converting the analog sensor signal into a digital value. 
The signal conditioning unit 203 is necessary to process the sensor signal before it is inputted to the microprocessor 204. 
[0029] The microprocessor 204 comprises a register for storing the sensor signal outputted from the A/D converter 
203, an ALU (Arithmetic Logic Unit) and an FPU (Floating Point Unit) for compensating for the attitude error of the 
earth magnetic sensor and calculating the azimuth information, and an internal timer for setting an output period fbr 
transmitting the sensor data and the calculated azimuth Information to the LCD module and the external device. 
[0030] The LCD module 205 displays the azimuth information outputted from the microprocessor 204, so that the 
user can recognize the azimuth angle of the device having the earth magnetic sensor module mounted thereon. 
[0031] The serial communication interface 206 is for transmitting the sensor data and the azimuth Information out- 
putted from the microprocessor 204 to the external d.evice. and it may adopt asynchronous serial communication or 
synchronous serial communication type. 

[0032] FIG. 3 is a flowchart illustrating the operation of the microprocessor mounted on the two-axis earth magnetic 
sensor and an attitude error compensation apparatus according to the present invention. 

[0033] First, in order to transmit the output values of the two-axis earth magnetic sensor 201 and the inclinometer 
202 and the finally calculated azimuth information to the external system, the data output period is set using the internal 
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timer mounted on the microcomputer 204 (step 301). 

[0034] In order to convert the output.vaiues of the earth magnetic sensor 201 and the inclinometer 502 into digital 
values, an A/D converter control signal is produced (step 302), and then the converted sensor data is stored in the 
internal register (step 303). 

s . [0035] The attitude of the sensor module is calculated through Equations 2a and 2b using the" inclinometer data 
among the stored sensor data (step 304). Using this calculated attitude, the coordinate conversion matrix is calculated 
through Equation 3 (step 305). ' • . ■ 

[0036] The virtual Z-axis earth magnetic data Is generated through Equation A using the calculated altitude and the 
earth magnetic sensor data stored in the internal register (step 306). 
10 |0037] The three-axis earth magnetic data (i.e.. two-axis earth magnetic sensor data one-axis calculated virtual 2- 
axis earth magnetic data) Is converted into the strength of the earth magnetic field in the horizontal coordinate system 
through Equation 5 using the calculated coordinate conversion matrix (step 307). Using this converted data, the azimuth 
angle is calculated through Equation 6 (step 308). 

[0038] It Is searched whether an interrupt is generated by the data output period set in the Internal timer (step 309). 

IS . [0039] If it is searched that the timer interrupt is not generated, the present step returns to the previous step 302 of 
converting the sensor data into the digital value to repeat the performing of the step 302. Meanwhile, if it is searched 
that the tinier interrupt Is generated (step 309).. the azimuth information calculated as above and the sensor data .are 
transmitted to the external system using the. serial communication (step 310), and outputted to the LCD module for 
display (step 311). After that, the operation returns to the step 302 of converting ser^sor data into digital value and 

20 repeats the steps thereafter until the next timer interrupt Is generated. 

. [0040] FIG. 4 is a graph illustrating the experimental result of the attitude calculated through Equation 2 using the 
Inclinometer 202 according to the present invention. 

[0041] FIG. 5 is a graph illustrating the experimental result of the virtual Z-axis earth magneticdata calculated through . 
Equation 4 in comparison to the Z-axis of the three-axis earth magnetic sensor. In FIG. 5, the dotted line represents 
'25 ■ the Z-axis of the three-axis earth magnetic sensor, and the solid line represents the virtual Z-^ls earth magnetic data 
calculated through Equation 4. It can be recognized that the Z-axis earth magnetic data, which varies according to the 
change of the attitude, Is accurately generated through Equation 4. 

[0042] FIG. 6 is a graph illustrating the experimental result of the azimuth angle calculated through Equations 5 and 
6 using the generated virtual Z-axis earth magnetic data, the output of the two-axis earth magnetic sensor, and the 
30 calculated coordinate conversion matrix in the case that the? attitude is changed. The dotted line represents the un- 
compensated azimuth angle,- which shows a great change* of the azimuth angle, while the solid line represents the 
compensated azimuth angle, which shows that the azimuth angle Is changed only within an error range where the 
chs^nge of the azimuth angle is small. 

[0043] According to the apparatus for calculating the azimuth angle by the attitude error ccmpensation of the earth 
36 magnetic sensor according to the present invention, the azimuth information is provided to the user using a two-axis 
earth magnetic sensor and a two-axis inclinometer, and overcoming the technical limit of the two-axis earth magnetic 
sensor module. This avoids the need for. existing three-axis earth magnetic sensors with the inclinometer, 
[0044] The present invention can be conveniently used in any situation when the azimuth information is required. 
For example, when it is Intended to confirm the user's heading direction using an electronic map stored in a PDA, the 
40 present accurate azimuth angle of the user is recognized and the map is rotated accordingly to be displayed on the 
LCD of the PDA, so that the user can conveniently determine his/her own heading direction. 

[0045] Also, the present invention facilitates the implementation of the three dimensional game through the informa- 
tion on the rotating direction of the game machine in addition to the attitude of the game machine, and further It can 
used as the data Input device of the virtual reality. 
45 ' [0046] While the present invention has been described in detail, it should be understood that various changes; sub- 
stitutions and alterations can be made hereto without departing from the scope of the invention as defined by the ' 
appended claims. 



50 Claims 

1. An apparatus for calculating an azimuth angle, comprising: 

a two-axis earth magnetic sensor, mounted on a device which requires azimuth information, for measuring a 
55 strength of an earth magnetic field according to the azimuth information if the device moves; 

. an inclinometer used for calculating an attitude such as a roll and a pitch angle; 
an analog-to-digital (A/D) converter for converting sensor data into a digital value: 

a microprocessor for calculating the azimuth information by compensating for an attitude error using outputs 
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of Ihe two-axis eerlh magnetic sensor and the inclinometer; 

a serial communication interface for transmitting the data processed by the microprocessor; and 
an LCD module for displaying the azimuth Information calculated by the microprocessor. 

5. 2. An apparatus for calculating an azimuth angle, comprising; 

a two-axis earth magnetic sensor: 
a two-axis inclinometer; and 

means for calculating an altitude using an output of the inclinometer, and for calculaUng azimuth by compen- 
*° sating for an attitude error of the Iwo-axis earth magnetic sensor. 

3. An apparatus for compensating for an atliiuds error of a two-axis earth magnetic sensor, comprising: 

an Input for receiving data from a two-axis earth magnetic sensor 
an input for receiving data from a two-axis inclinometer; and 

means for calculating an altitude using an output of the Inclinometer, and for compensating for an attitude 
error of the two-axis earth magnetic sensor. 



20 



4. A method of calculating an azimuth angle, comprising: 



25 



a flrst step of setting a data output period using an Internal timer mounted on a microcomputer; 
a second step of converting an analog value sensed by a sensor into a digital value using an analog-lo-digital 
converter; 

a third step of staring the converted sensor data in an internal register of the mlcropjrocessor; 
a fourth step of calculating the attitude and obtaining a coordinate conversion matrii' using inclinometer data; 
a fifth step pf generating a virtual Z-axis earth nnagnetic data in the case of using a two-axis earth magnetic 
sensor; 

a sixth step of calculating earth magnetic data on a horizontal coordinate system using a three-axis earth 
magnetic data (i.e., the two-axis earth magnetic sensor data plus the one-axis virtual sensor data) and the 
coordinate conversion matrix; ' 

a seventh step of calculating the azimuth angle using the calculated data; and 

an eighth step of. if a timer interrupt Is generated due to the output period set in the internal timer, transmitting 
the sensor data and. the calculated azimuth data to an external system through a serial communication and 
displaying the sensor data and the calculated azimuth data on an LCD module. 



35 



5. The method of claim 4. wherein an algorithm for generating the virtual Z-axis earth magnetic data comprises: 



a first step of measuring by experiment a strength of an earth magnetic field measured when a measurement 
axis of the earth magnetic sensor points to a vertically downward direction of the earth; 
a second step of calculating the attitude using an output of the inclinometer; 

a third step of measuring Ihe strength of the earth magnetic field sensed in X-axis (i.e., front) and Y-axis (i.e.. 
right) directions of a sensor module using the two-axis earth magnetic sensor; and • 
a fourth step of generating the virtual Z-axis earth magnetic data using the calculated' attitude of the sensor 
module and an output value of the two-axis earth magnetic sensor. 

45 ' 

• 6. The method of claim 5, wherein an algorithm for calculating the earth magnetic data on the horizontal coordinate ' 
system comprises; 

a first step of calculating the coordinate conversion matrix using the attitude calculated using an output of the 
inclinometer; and 

a second step of calcuiating the earth magnetic data of the horizontal coordinate system by multiplying the 
generated 2-axis earth magnetic data and the measured X-axIs and Y-axis earth magnetic data by the calcu- 
lated coordinate conversion matrix. 



55 



7. The method of claim 6. wherein an algorithm for calculating the azimuth information using the two-axis earth mag- 
netic sensor comprises: 

a first step pf calculating the attitude using the inclinometer and obtaining the coordinate conversion matrix; 
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a second step of generating the virtual Z-axis earth magnetic data; 

a third step of generating the earth nr^agnetic data on the horizontal coordinate system; and 

a fourth step of calculating the azimuth angle using X-axis and Y-axis data of the earth magnetic data on the 

horizonlaf coordinate system. 

5 ' 
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FIG. 2 
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FIG. 3 
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FIG. 6 
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